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Анализ эффективности существующих 
методов уклонения от столкновения 
для мобильного робота 


В статье рассматривается проблема планирования движения мобильного робота с учетом обхода препятствий. 
Проводится анализ эффективности существующих методов избежания столкновения и обхода препятствий 
для мобильного робота. 


Введение 


В робототехнике принято представление о роботе как механизме, управляемом 
центральным контроллером (мозгом), который постоянно обновляет свое представле- 
ние об окружающем мире и вырабатывает план поведения, исходя из этого представ- 
ления. Новая информация о мире поступает от сенсоров, например: осязания, света, 
ультразвука и т.д. Мозг анализирует всю информацию, обновляет представление об 
окружающей среде, а затем принимает решение о том или ином действии. Данный под- 
ход сопряжен с определенными трудностями. Во-первых, он требует большого объема 
вычислений. Во-вторых, поддержка актуальной картины окружающего мира — задача 
очень сложная, т.к. мир меняется постоянно. Все действия выполняются с помощью 
приводов и эффекторов. Первые обычно представляют собой некие двигатели, под- 
соединенные к устройствам, непосредственно взаимодействующим с окружающим 
миром — эффекторам. Примерами последних могут служить колеса или руки. При этом 
иногда под приводами понимаются как сами приводы, так и эффекторы. 

Целью данной работы является анализ эффективности существующих методов 
уклонения мобильных роботов от столкновений для последующего использования 
их в разработке систем предотвращения столкновения объектов. 


Классификация существующих методов уклонения 
роботов от столкновений 


Наиболее общими движениями робота являются движения, связанные с обходом 
объектов, для которых единственное ограничение состоит в том, чтобы робот не столк- 
нулся с объектами в рабочем пространстве. Поэтому при разработке различных задач 
важно планировать движения мобильного робота с учетом обхода препятствий. В раз- 
ных областях были предложены различные алгоритмы обхода препятствий. Ниже кратко 
изложим эти алгоритмы, предназначенные для обхода роботом препятствий в трех- 
мерном пространстве. 

Алгоритмы можно разделить на несколько классов: 


«Штучний 1нтелект» 42010 935 


вп. Плотников В.А. 


— гипотеза — тест; 

— штрафная функция; 

— метод скелетирования; 

— нечеткая логика. 

1. Раньше других был предложен метод гипотезы и теста, состоящий из трех ос- 
новных шагов: 

а) предлагается гипотеза относительно пути-кандидата между начальной и конеч- 
ной конфигурациями мобильного робота при движении; 

6) набор конфигураций вдоль этого пути тестируется на возможность столкно- 
вений; 

в) если столкновение оказывается возможным, с целью определения пути обхо- 
да исследуется препятствие, которое может вызвать это столкновение. 

Весь процесс повторяется для модифицированного движения. 

Главное преимущество метода «гипотеза — тест» заключается в его простоте. Ос- 
новными вычислительными операциями метода являются определение возможных стол- 
кновений и модификация путей для предотвращения столкновений. Первая операция 
равнозначна способности определять ненулевое геометрическое пересечение между 
моделями манипулятора и препятствий. Эта возможность, как правило, имеется в боль- 
шинстве систем геометрического моделирования. Вторая операция-модифицирование 
предложенного пути может быть очень трудной. Обычные предложения модифика- 
ции пути основываются на аппроксимации препятствий в виде замкнутых сфер. Эти 
методы хорошо работают, когда препятствия расположены редко. Когда же простран- 
ство заполнено объектами, попытки избежать столкновения с одним препятствием 
обычно приводят к столкновению с другим. В таких условиях определение возможных 
столкновений может быть осуществлено более точно, если применить систему техни- 
ческого зрения и/или другие системы очувствления [1]. 

2. Второй класс алгоритмов обхода препятствий основывается на определении 
штрафной функции для конфигурации мобильного робота, с помощью которой коди- 
руется наличие объектов. 

Метод штрафных функций относится к численным методам решения задач ус- 
ловной оптимизации. В данном случае исходная задача условной оптимизации преоб- 
разуется в последовательность задач безусловной оптимизации путем введения штраф- 
ных функций. Рассмотрим задачу условной минимизации вида 

Г(х) > т, 
хЕХ ={хЕК" : 2. (х)<01=17}. 

На ее основе строится задача безусловной минимизации 

Р(х,К) = Г(х)+О(К, е(х)) > шш, хЕК", 
где Р(х, №) — расширенная функция, 

0(К, е(х)) — штрафная функция, 
К - штрафной параметр. 

Задача условной минимизации /(Х) заменяется последовательностью задач без- 
условной минимизации Р(х, К, |) при Е= 1, 2... При этом, исходя из заданной началь- 
1 находится последовательность точек Х ы , и ‚ сходящаяся при опре- 


* 


деленных условиях к решению Х исходной задачи. При минимизации расширенной 


ной точки Хх 
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> > > 7 
функции Р(х, А), 1=1, 2..., исходной (начальной) точкой является х(', а реше- 


> [А 
ние задачи безусловной минимизации Р(х, В, ) определяет точку х". 


Обычно для конфигурации, которая приводит к столкновениям, значение штрафа 
равно бесконечности и резко падает по мере увеличения расстояния от препятствий. 
Полная штрафная функция представляет собой сумму штрафов отдельных препят- 
ствий, к которой иногда добавляется штрафной член отклонения от кратчайшего пу- 
ти. Для каждой конфигурации мы можем вычислить значение штрафной функции и 
оценить ее частные производные по отношению к параметрам конфигурации. На ос- 
нове этой локальной информации с помощью функции поиска пути необходимо выб- 
рать последовательность конфигураций. Решение должно соответствовать локально- 
му минимуму штрафной функции, т.е. компромиссу между увеличением длины пути 
и максимальным приближением к препятствиям. 

Интерес к методам штрафных функций основан на том, что они обеспечивают 
относительно простой путь комбинирования ограничений от различных объектов. Од- 
нако это справедливо лишь для робота с вращательной степенью свободы; в этом слу- 
чае вид штрафной функции легко получить исходя из формы препятствия. Для боль- 
шинства реальных роботов, таких, как двухзвенный манипулятор, штрафную функцию 
можно было бы определить через преобразование конфигурации препятствия в про- 
странстве. В противном случае движения робота, уменьшающие значения штрафной 
функции, не были бы безопасными. Различие между этими двумя типами штрафных 
функций характеризуется тем, что движение вдоль уменьшающихся значений штраф- 
ной функции является безопасным, в то же время подобное движение мобильного ро- 
бота приводит к столкновению. 

Иногда промежуточные методы используют штрафную функцию, которая удов- 
летворяет определению потенциального поля. Градиент поля в точке робота интерпре- 
тируется как сила отталкивания в этой точке, которая суммируется с силой притяжения, 
действующей из конечного положения робота. Движение робота является результа- 
том взаимодействия этих двух сил при наличии кинематических ограничений. Исполь- 
зуя несколько точек робота, можно избежать столкновения. 

Основным недостатком использования штрафных функций для планирования без- 
опасных путей является точная локальная информация, которую они дают для поиска 
пути. Попытки определения пути по локальным минимумам штрафной функции могут 
привести к тупиковым ситуациям, когда дальнейший поиск пути становится невозмож- 
ным. В этом случае алгоритм должен выбрать предыдущую конфигурацию и продол- 
жить поиск в другом направлении. Такие точки возврата трудны для идентификации 
на основе локальной информации. Поэтому полезно комбинировать метод штрафных 
функций с более общим методом «гипотеза — тест». Штрафные функции более удобны 
в тех случаях, когда требуются только небольшие модификации известного пути [2]. 

3. Алгоритмы скелетирования сводят свободное пространство робота к одномер- 
ному представлению, для которого задача планирования пути становится проще. Та- 
кое представление с меньшим количеством измерений называется скелетом простран- 
ства конфигураций. 

Пример применения метода скелетирования приведен на рис. 1: это — линия Во- 
роного для свободного пространства, которая представляет собой геометрическое мес- 
то всех точек, равноудаленных от двух или нескольких препятствий. Для того чтобы 
осуществить планирование пути с помощью линии Вороного, мобильный робот вна- 
чале переходит из текущей конфигурации в точку на линии Вороного. Можно легко 
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показать, что такую операцию всегда можно выполнить с помощью передвижения по 
прямой в пространстве конфигураций. Затем мобильный робот следует по линии Во- 
роного до тех пор, пока не достигнет точки, ближайшей к целевой конфигурации. На- 
конец, робот покидает линию Вороного и движется к цели. И на этом последнем этапе 
снова выполняется движение по прямой в пространстве конфигураций. 


к 


Рисунок 1 — Линия Вороного для свободного пространства 


Один из примеров метода скелетирования: линия Вороного — это геометричес- 
кое место точек, равноудаленных от двух или нескольких препятствий в пространстве 
конфигураций. 

Таким образом, первоначальная задача планирования пути сводится к поиску 
пути на линии Вороного, которая обычно является одномерной (за исключением не- 
которых частных случаев) и имеет конечное количество таких точек, в которых пе- 
ресекаются три или большее количество одномерных кривых. Движение по линии 
Вороного может не обеспечить получение кратчайшего пути, но обнаруженные пути 
будут отличаться наличием максимальных расстояний от препятствий. Недостатки ме- 
тода, основанного на использовании линии Вороного, состоят в том, что их сложно 
применять в пространствах конфигураций с большими размерностями, кроме того, 
при их использовании приходится совершать слишком большие обходные маневры, ес- 
ли пространство конфигураций характеризуется широким размахом. К тому же может 
оказаться сложным вычисление линии Вороного, особенно в пространстве конфигу- 
раций, характеризующемся сложной формой препятствий [3]. 

4. Нечеткая логическая система производит однозначное преобразование векто- 
ра входных сигналов в вектор выходных сигналов. Для этого преобразования исполь- 
зуется механизм нечеткого вывода, основанный на знаниях, заложенных экспертом. 

Входным и выходным сигналам в нечеткой логической системе соответствуют ло- 
гико-лингвистические переменные, значения которых определяется термами-множест- 
вами. База знаний нечеткой логической системы состоит из продукционных правил, 
определяющих зависимость между входными и выходными термами-множествами, 
и функций принадлежности, показывающих степень соответствия реальных величин по- 
нятиям, определяемых термами-множествами. 

Например, пусть имеется входной сигнал скорости У. Определим для логико-линг- 
вистической переменной Г три значения: «МАЛАЯ», «СРЕДНЯЯ» и «БОЛЬШАЯ». 
Соответствия между реальными значениями скорости и значениями переменной Г оп- 
ределяются по их функциям принадлежности (рис. 2). Таким образом, диапазон скорос- 
тей от 0,3 до 0,6 м/с с достоверностью 1 относятся к понятию «СРЕДНЯЯ». Скорости 
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0,2 м/с и 0,7 м/с к понятию «СРЕДНЯЯ» относятся с достоверностью 0,5. Скорости 
0,1 м/с и ниже, равно, как 0,8 м/с и выше, к понятию «СРЕДНЯЯ» не относятся 
(т.е. достоверность равна 0). 

М 


{ 


] МАЛАЯ СРЕДНЯЯ БОЛЬШАЯ 


Рисунок 2 — Функции принадлежности по входной переменной 


Весь диапазон возможных значений выходной переменной функциями принад- 
лежности разбивают на несколько частей (рис. 3). Удельный вес некоторых выходных 
функций принадлежности может доминировать над удельным весом других функций 
принадлежности. Такие функции принадлежности будут доминировать при принятии 
совместных решений по нескольким правилам. 


МАЛО 6) 


Рисунок 3 — Функции принадлежности по выходной переменной 


Достоинством технологии нечеткой логики является: 

— возможность плавного перехода от одной категории к другой за счет формиро- 
вания средневзвешенного результата, что позволяет существенно сократить число про- 
дукционных правил по сравнению с экспертной системой; 

— возможность объяснения результата в процессе отладки системы [4]. 


Математическая модель движения мобильного робота 


Мобильный робот представляет собой четырёхколесную базу с двумя ведущими 
колесами, электродвигателями для ведущих колёс. Схема мобильного робота показа- 


на на рис. 4. 
Направление движения 


Левое ведущее |^^ Правое ведущее 
колесо колесо 
У! 


скорость 


Рисунок 4 — Схема мобильного робота 
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Составим кинематическую модель для мобильного робота. 


=", +И, 


К 
о=-5* И), 


у =зша*И, 
у. =соза*7Т, 
а=о. 
где у1, у2 — координаты робота на плоскости; 
У - скорость робота; 
\! — скорость левого ведущего колеса; 
У» — скорость правого ведущего колеса; 
@ — угловая скорость робота при поворотах; 
4 — угол поворота робота в плоскости; 
К — коэффициент передачи привода. 

Для определения препятствия на мобильном роботе необходимо разместить 
массив микроволновых сенсоров. Принцип действия микроволнового активного метода 
обнаружения основан на излучении в окружающее пространство электромагнитного 
поля СВЧ диапазона и регистрации его изменений, вызванных отражением от объек- 
та, движущегося в зоне чувствительности сенсора. Микроволновые активные сенсоры, 
реализующие этот метод, относятся к классу детекторов движения. Перемещение объекта 
приводит к появлению изменяющегося во времени отраженного сигнала. Здесь разли- 
чают два эффекта: изменение пространственной картины стоячих волн и частотный 
сдвиг отраженной от движущегося объекта волны (эффект Доплера). Принцип разме- 
щения массива микроволновых сенсоров на мобильном роботе показан на рис. 5. 


Рисунок 5 — Размещение массива микроволновых датчиков на мобильном роботе 


Данные, получаемые от массива микроволновых датчиков, формируют картину 
окружающего мира для мобильного робота. Датчики расположены таким образом, что- 
бы охватить как можно большую площадь слева, впереди и справа от направления дви- 
жения мобильного робота. 

На основе данных, полученных от массива микроволновых сенсоров о препятст- 
виях, находящихся около робота, можно построить навигационную систему. Разделим 
навигационную систему на два блока: 

а) блок движения к цели; 

6) блок обхода препятствий. 
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а) Сформируем набор правил для блока движения к цели с помощью нечеткой 
логики, используя правило «если, то». 

ЕСЛИ необходимо двигаться к цели под углом — 459, ТО движение «влево-вперед». 

ЕСЛИ необходимо двигаться к цели под углом 0’ ТО движение «вперед». 

ЕСЛИ необходимо двигаться к цели под углом +450, ТО движение «вправо-вперед». 

Выходом данного блока будет нечеткое множество направлений движения мо- 
бильного робота. 

6) База правил для блока обхода препятствий будет содержать пять правил, по 
одному для каждого сенсора. 

ЕСЛИ дистанция до сенсора —90° «близко», ТО движение запрещено 

ЕСЛИ дистанция до сенсора —45° «близко», ТО движение запрещено 

ЕСЛИ дистанция до сенсора 0° «близко», ТО движение запрещено 

ЕСЛИ дистанция до сенсора +450 «близко», ТО движение запрещено 

ЕСЛИ дистанция до сенсора +90° «близко», ТО движение запрещено. 

Выходом блока обхода препятствий будет нечеткое множество запрещенных на- 
правлений движения робота [5]. 


Выводы 


После анализа методов уклонения роботов от столкновений становится понят- 
ным, что использование лишь одного метода не является эффективным. Существующие 
методы уклонения от столкновений роботов являются узконаправленными и зачастую 
зависят от конфигурации робота либо от окружающей среды, в которой использует- 
ся робот. В результате выполнения работы была предложена математическая модель 
движения мобильного робота. Составлена схема размещения массива микроволно- 
вых датчиков на мобильном роботе и сформулированы правила нечеткой логики для 
движения и обхода препятствий мобильным роботом. 
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> 


В.О. Плот ков 

АналВ ефективност! 1снуючих метод ухилення вд зткнення для мобльного робота 

У статт! розглядаеться проблема планування руху моблльного робота з урахуванням обходу перешкод. 
Проводиться анал!з ефективност! 1снуючих метод1в запоб1гання заткнення Й обходу перешкод для 
моб@льного робота. 


Г.А. РопиКоу 

Апа1у$1$ 07 ЕЁЙаепсу 01 Пе СоШ$10оп АуоЧапсе Мео4$ ве Моше Воро: 

п Фе агасе Фе рго Мет оё р!аппше оЁ тоуетепе оЁ фе тобШе гобо{ {аКте по ассоип деютг оЁ об5ас[ез 1$ 
сопз14еге4. Те апа[уз15 оЁ еЁЙсепсу оЁ ех15 пя те о4$ о фе соШз1оп ауо14апсе ап4 деючг оЁ обасез Рог 
Фе шобПе гоБо+ 1$ сагле4 оп. 


Статья поступила в редакцию 14.06.2010. 


«Штучний 1нтелект» 42010 541 


